DEVICE ANPOS

• The internal ANPOS device is a tool that allows to manage the movement of a mechanical axis with a trapezoidal ramps to analog command.
• The main function of the device is to generate a trajectory or 'speed profile' that if converted into a proportional voltage signal, commands the motor through a drive.
• The device includes a feed-back process on the measurement taken from the position transducer. This measure compared to generate feedback.
• The control voltage for operation is generated by a hardware DAC (Digital to Analogic Converter) of the BUS QMOVE.
• To sync the device with the actual axis position returned by the axis, there is a special procedure for moving called 'presets search'.
• The feed-back is the PID+FF type (proportional, integral, derivative and feed-forward).
  Wiring and connections of the equipment described in this manual, muust comply with the European standard EN60204-1.

In the configuration unit, the BUS section must be declared so that so that you have the hardware resources required for the implementation of the device ANPOS. There must be at least a bi-directional counter and a 16-bit resolution analog output. The device can also used an input and an interrupt line for preset search functions.
In the INTDEVICE section of the configuration unit must be add the following definition:

;---------------------------------
; Device declarations
;---------------------------------
INTDEVICE
..
<device_name>  ANPOS  TCamp  ICont  IntL  IAZero  IOutA

	It is necessary that each definition are present on the same line. In case you don't want to assign a resource, for example IAZero, you must enter in the appropriate field the X.X or X string.

where:

;---------------------------------
; Device declarations
;---------------------------------
INTDEVICE
Asse_X    ANPOS 2   2.CNT02  3  3.INP01  3.AN01

The ANPOS device acquires the position of axis via bi-directional transmitter signals; these signals are used by an internal counter. This counter does not show directly the position of the axis in the unit of measure required by your application. The cntratio parameter is used to express the relationship between pulses transducer and the corresponding application units. The permitted values for this parameter are 0,00374 ÷ 4 with five precision digits. The report must be introduced in parameter as an integer, and then multiplied by 100000.
cntratio = (value in um) x 10 ^{decimal digits} / (corresponding transmitter pulse) x 100000

If for the selected measure unit is also provided for the presence of a decimal point, the positions must be represented always as an integer value and represent space on the measure unit without the decimal point. The resolution must be calculated with the same formula and the numerator the measure without decimal point. The decimal point will be entered in the value representing the time viewers (example as properties in the terminal operator).

The speeds are always expressed in whole units of measure in the unit of time choice. From this it emerges that the device must know the location of the decimal point of the unit of measure and this is done with the decpt parameter. This parameter can take 0÷3 values.

	To activate this device send the INIT command.

• You want to represent the positions in centimeters with a decimal point.
• In 18.2cm of the space the transducer generates 500 pulses.

To calculate the resolution you have to consider the space runs represented in terms of the measuring mm unit. For this the resolution is:
cntratio = (18.2 x 10¹ / 500) x 100000 = 36400

The settings must be:
Axis:cntratio = 36400
Axis:decpt = 1

To run a placement at 146 cm, put
Axis:setpos = 1460

For setting the 10 centimeters per second must put:
Axis:unitvel = 1
Axis:setvel = 10

	Before starting actual placements you must make sure that electrical connections and mechanical appliances have not cause malfunctions.

For axis management, thee ANPOS device using an analogue output with 16-bit resolution with 10 V range ± and sign; with the calibration function this analog output can be driven with a constant value in order to test links and functionality.

• Remove the emergency condition with the RESUME command.
• The st_emrg state = 0
• Enable calibration axis status with the CALON command; the st_cal state must therefore take the value 1.
• Now you can set the analog with voltage vout paramenter; the value is expressed in tenths of a volt (-100 ÷ 100 = -10 ÷ 10 V). It is recommended to introduce low values (5, 10, 15 … like 0.5, 1, 1,5 V).
• When the axis is moving the frq parameter indicates the frequency in Hz of the transducer phases.
• The parameter posit displaying the location, varies the space indicating axis. If setting a positive voltage the counter decreases, it is necessary to invert the phases of the transducer or reverse the drive directions.
• You can reverse the direction of the count using the CNTREV command.
• If output voltage equal to zero the axis is not stationary, adjust the offset parameter to correct the voltage until movement stops. The input value (each bit corresponds to approximately 0.3 mV), will be added algebraically to the value of the analogue output; This operation allows to compensate for any drift in the electronic component, and output from QMOVE that entering the drive. The value is expressed in bits with sign.
  For an optimal result of calibration this operation must be performed with the system to temperature capacity..
• To disable calibration status send the CALOFF command.
• The state st_cal = 0

The ANPOS device raises the voltage value of the analogue output on the basis between the maximum speed of the axis and the maximum output voltage proportion. La proporzionalità è ottenuta with the maxvel parameter, maximum axis speed representative on the analog voltage (10 V). The axis must behave symmetrical analog voltage to zero, therefore the speed must be the same on both the positive and negative voltage at maximum.
Before you determine the value of the maximum speed, must establish the unit of time to use for the representation of the speed in the device; the unitvel parameter defines the unit of time of speed (Um/min or Um/s).

The theoretical method is a calculation that was performed on the basis of the maximum speed of the motor. Set the maximum revolutions per minute engine declared, we get the maximum speed.
Setting in the maxvel parameter the maximum speed value calculated.

The practical way is based on the reading of the speed detected by the device in the vel variable, giving the drive a voltage. To provide the voltage to drive the device should be placed in a position of calibration as described in the previous paragraph. If the system permits, supply voltage operation of 10 V and read the speed value in the vel parameter. If, on the backwards, is an excerpt of the output voltage (1, 2, … 5 V), calculate the maximum speed with the proportion: vout : 10 [V] = vel : maxvel

Enter the maximum speed value found in maxvel parameter.

	Before handling the Board, check the proper operation of emergency equipment and protection.

The procedures were allowed to complete the first phase of device settings. Now you can run smooth movement of the axis.

• Move the axis in a position whereby it can fulfill a certain area without touching the maximum quota limit.
• Set the current position of the axis to zero, by setting the posit parameter = 0.
• Set up the parameters that define the position of the limit switches software: minpos = 0 and maxpos to the value of the maximum stroke of the axis.
• Set the parameter that defines the time from the axis to reach the maximum speed taccdec = 100. This parameter is expressed in hundredths of a second (100 = 1 sec.)
• Set the speed of positioning with the setvel parameter.
• Set the target altitude with the setpos parameter.
• Set the feedforward parameter = 1000 (100%)
• If the device is in Emergency State of (st_emrg = 1) give the RESUME command.
• Start positioning with the START command. To stop the movement give the EMRG command.

This first movement was done without speed feedback space. The placement may have been executed with some error introduced by the non-linearity of the components or imperfection in the maximum velocity calibration. Then if you enable feedback of space this error goes away.

The placement made in the preceding paragraph has been made without considering any position errors.
To check the correct position of the axis continuously and automatically, you must have a feed-back on the position; for this reason introduces the control PID + FF algorithm including proportional, integral, derivative actions and feed-forward; the value of the analog output is given by the summation of actions feed forward, proportional, derivative and integrative.
This section describes a series of actions to adjust the parameters that affect this control.
In order to achieve a satisfactory adjustment is sufficient to use only the feedforward and proportional actions; integral and derivative actions are used only for adjustments under special conditions.

The feed-forward helps make the system more ready on positioning, by providing the analog output voltage proportional to the theoretical speed of positioning.
The contribution of this action can be adjusted with the feedfw parameter; this parameter is expressed as a portion of millesimal theoretical speed; so, to introduce such as 98.5% you must set 985 (MILS).

This action provides an proportional output to the instantaneous axis position error. The size of the proportional action is defined by the pgain parameter that defines the sensitivity of the system.
The pgain parameter is introduced in thousandths; the unit value of the gain (1000) provides an analog output to maximum value (10 V) concerning the maximum speed error. For maximum speed error means the space taken by axis - at the max speed - for the duration of the sampling time of the device.

Integrates the position error of the system over time set in integt parameter updating the output until the error is reset.
More decreases the integration time of the error, more faster the recovery system error, but the system may become unstable and swung.

Anticipates the change of the motion of the system tends to eliminate the overshoot the positioning. The size of change is calculated over time set in derivt parameter.
More higher the time of derivation of error and more faster is the transient error recovery system, But if you enter a value that is too high the system becomes unstable, tending to fluctuate.

Searching for presets is a procedure to synchronize the counter (posit parameter) with the real position of the axis. Can be performed in 3 different ways according to the prsmode parameter.

• In order to execute a search preset input is needed (acquired via the QMOVE BUS) we call 'enabling zero transducer'. In this trajectory, the axis must activate this input into a particular point.
• The preset search procedure is started with the PRESET command; early counting from QMOVE can have any value and can be located anywhere.
• The axis must direct towards the cam allows the upload of preset. Not knowing which way to direct the axis to meet the enable input, search for preset lets you choose two solutions with the prsdir parameter:
  prsdir =0 the axis will always a movement forward
  prsdir =1 the axis will always a movement back
• If during the preset search is given a PRESET command, the direction of motion of the axis is reversed.
• Note that the share of presets contained in the prspos parameter must be always between the minimum and the maximum quota and after the preset quota load, the axis is automatically positioned to the preset quota.
• When searching preset the software limits maxpos and minpos are disabled.
• When you set the search speed zero pulse - sprsvel - we must consider that in the 0 Mode the input has a hardware filter that delays the acquisition and therefore influence the precision of the loading. In the 1 Mode, the acquisition is made on interrupt input, so the speed is not determinative. We must ensure that the operating time of the zero-pulse is sufficient to be acquired from the card. In order to know the acquisition time of the entrance and the minimum time of zero pulse signal refer to the technical documentation of the used cards.

If enable the preset search with the PRESET command, the axis towards the position where you active the enable zero-pulse input of transducer with speed define by prsvel. The st_prson state you turn to report the current preset. When, in this motion, the axis active the input, reverses direction and starts with sprsvel speed.
The operation depends from the selected mode of loading (Mode 0 or Mode 1).

	This procedure involves the movement of the axis and the use of the zero pulse enable input of the transducer.

The deactivation of the enable input zero-pulse transducer, the preset quota is loaded on the counter (parameter posit=prspos).
Next, you disable the st_prson status and activate the st_prsok state to signal the end of search. This state remains active until the starting of a new procedure of presets; at the system startup this State is always to zero. See the picture 1.

Picture 1: Loading presets using the only enabling cam.

	This procedure involves the movement of the axis and the use of the zero pulse and zero pulse enable input of the transducer.

At the deactivation of the enable input zero-pulse transducer, enables reading of the first zero-pulse provided by the transducer and on this signal, loads the preset quota in counting (parameter posit=prspos).
To load the share presets with 'Mode 1', the card which is attached to the zero-pulse trasducer must transmit this signal on one of the 8 hardware interrupt lines. The device must have been defined to use the same hardware interrupt line (see the definition in the .CNF file).
Subsequently, the axis is positioned at an presets quota, to disable the st_prson state and enable the st_prsok state for to signal the end of search; This State remains active until the starting of a new preset procedure. At the startup of the instrument the st_prsok parameter is always to zero. See the picture 2.

Picture 2: Loading presets using the enable cam and the zero pulse of transducer.

Con questa procedura, la ricerca di preset non esegue nessun posizionamento. Il comando di caricamento della quota di preset viene fornito dall’attivazione dell’ingresso di abilitazione zero encoder e lo stato st_prsok viene impostato a uno.
Se l’ingresso rimane attivo il caricamento è continuo mentre, se all’accensione l’ingresso è già attivo, il primo caricamento viene eseguito solo dopo una sua disattivazione e successiva attivazione.

In alcune applicazioni viene richiesto di posizionare un numero elevato di assi movimentando un singolo asse alla volta. La scelta progettuale ricade sull’installazione di un solo azionamento che a seconda dell’asse da posizionare si collega elettricamente al motore interessato al posizionamento; il trasduttore é sempre vincolato al relativo asse.
Il device ANPOS permette di controllare l’accesso al dispositivo DAC tramite i comandi REGON e REGOFF. In questo modo tramite l’applicativo in QCL definisce una serie di device tanti quanti sono gli assi da posizionare; nella definizione, tutti i device utilizzano la stessa risorsa DAC (IOutA).
Normalmente tutti i device devono essere nello stato st_regoff = 1 in modo da non avere accesso al dispositivo DAC. Prima di iniziare il posizionamento, con il comando REGON, il device interessato viene portato allo stato di st_regoff = 0. Viene eseguito il posizionamento e, al suo completamento, il device viene riportato nello stato di st_regoff = 1 con il comando REGOFF. Per nessun motivo due device si devono trovare contemporaneamente nello stato di st_regoff =0.
Quando il device viene posto nella condizione di regoff, l’uscita analogica rimane fissa all’ultimo valore di tensione definito prima del comando REGOFF.

In alcune applicazioni viene richiesto di definire la quota di destinazione durante il posizionamento, in base ad eventi esterni al device. Questa caratteristica si traduce nella possibilità di scrittura nel parametro setpos anche con posizionamenti in corso.

Durante il posizionamento é possibile anche modificare il valore del conteggio posit. Questa funzione viene utilizzata solitamente quando un device deve, in particolari condizioni, continuare un profilo di velocitá per un tempo molto lungo, superiore al tempo che l’asse impiega per raggiungere la quota limite (maxpos o minpos).

Durante il posizionamento é possibile variare la velocitá dell’asse senza influenzare la posizione da raggiungere. Questa operazione può determinare un aumento o una diminuzione della velocitá, anche più punti dello stesso posizionamento. Questa operazione viene eseguita con nuova scrittura nel parametro setvel.

Durante il posizionamento possono essere variati anche i tempi di accelerazione/decelerazione. Per esempio il device può avviare un posizionamento con una rampa molto breve e, una volta raggiunta la velocitá impostata, viene variato il parametro tacc ed eseguito un cambio di velocitá con una rampa molto lunga.
Per applicazioni particolari il tempo di rampa può essere variato anche durante una variazione di velocitá, in questo caso il nuovo tempo viene messo in esecuzione immediatamente.

Il device visualizza sempre la posizione assoluta dell’asse; per eseguire posizionamenti incrementali è necessario disporre di uno strumento per sottrarre o sommare un determinato valore al conteggio (posit) senza introdurre errori. Il cambio di conteggio può essere eseguito anche con una scrittura diretta nel nuovo valore nel parametro posit.
Volendo sottrarre 100 unità di misura al conteggio è possibile:
Asse:posit = Asse:posit - 100

Questa operazione introduce un errore perché impone la posizione “posit = -100”, quando l’asse poteva avere una posizione intermedia tra una unità di misura e la successiva (es. 100.3). Questa frazione (0.3) viene persa ed il ripetersi di queste operazioni provocano l’accumularsi di un errore non trascurabile.
Il comando DELCNT somma al conteggio una quantità pari al parametro delta senza perdere la parte frazionaria della posizione:
Asse:delta = -100
DELCNT Asse
Il comando di DELCNT può essere inviato solamente con asse fermo (st_still=1)

La lettura della posizione dell’asse risulta essere di 2 unità e si trova nel punto A. Si vuole sommare al conteggio posit tre unità di misura.
Con le istruzioni:
Asse:posit = Asse:posit + 2
l’asse assume la nuova posizione B.
Con le istruzioni :
Asse:delta = 2
DELCNT Asse
viene raggiunta la posizione C.

Si noti che con le prime istruzioni l’asse ha compiuto un delta inferiore a 3 unità e quindi è stato introdotto un errore.
Se si devono inviare comandi DELCNT in successione, è conveniente calcolare la grandezza da sommare ed inviare una sola volta il comando; in caso contrario prestare attenzione a non inviare comandi successivi senza interporre una istruzione di lettura su parametro device.

Asse:delta = 3
DELCNT Asse
WAIT Asse:st_init
Asse:delta = 40
DELCNT Asse

Il nome del parametro, stato o comando viene riportato alla sinistra della tabella.

R
Indica se il relativo parametro o stato è ritentivo (al momento dell’inizializzazione del device mantiene lo stato precedentemente definito), oppure lo stato che assume al momento dell’inizializzazione del device.
Se il device non necessita di inizializzazione il campo “R” indica il valore che il parametro o stato assume all’accensione della scheda.
R = Ritentivo
0 = Al momento dell’inizializzazione del device il valore viene forzato a zero.
1 = Al momento dell’inizializzazione del device il valore viene forzato a uno.
- = Al momento dell’inizializzazione del device viene presentato il valore significativo.

D
Indica la dimensione del parametro.
F = Flag
B = Byte
W = Word
L = Long
S = Single Float

Vengono descritte tutte le condizioni necessarie affinché il parametro sia considerato corretto o perché il comando venga accettato.
In alcuni casi vengono specificati dei valori limite per l’accettazione del parametro: se vengono introdotti dei valori esterni ai limiti impostati, il dato viene comunque accettato; pertanto devono essere previsti opportuni controlli dell’applicativo tali da garantire il corretto funzionamento.
Per l’esecuzione di un comando, tutte le relative condizioni devono necessariamente essere soddisfatte; in caso contrario il comando non viene eseguito.

A
Indica la modalità di accesso.
R = Read (lettura).
W = Write (scrittura).
RW = Read / Write.

I comandi sono stati ordinati con priorità decrescente. Ad esempio, in caso di contemporaneità dei comandi INIT ed EMRG, viene acquisito per primo il comando INIT.

Nessuna limitazione

;*************************************************************************************
; Nome Modulo: Ex_Anpos.CNF              Progetto: Ex_ANPOS
; Autore: QEM srl                        Data: 01/05/99
; Sistema: QMove1 / QCL3                 Libreria: 1LIB3B04
; Funzionalità: Esempio gestione ANPOS   Release: 0
;------------------------------------- Note ------------------------------------------
; [1] - Applicativo di esempio per utilizzo device ANPOS
**************************************************************************************
 
;-------------------------------------------------------------------------------------
; Definizione Costanti
;-------------------------------------------------------------------------------------
CONST
 
;-------------------------------------------------------------------------------------
; Definizione Variabili SYSTEM
;-------------------------------------------------------------------------------------
SYSTEM
slQuotaPos   L                          ;Variabile per quota di posizionamento
slVelAsse   L                           ;Variabile per velocità asse
 
;-------------------------------------------------------------------------------------
; Definizione Variabili GLOBAL
;-------------------------------------------------------------------------------------
GLOBAL
gfMovMan   F                            ;Flag segnalazione movimenti
                                        ;manuali in corso
gfMovAuto   F                           ;Flag segnalazione movimenti
                                        ;automatici in corso
 
;-------------------------------------------------------------------------------------
; Definizione Variabili TIMER
;-------------------------------------------------------------------------------------
TIMER
 
;-------------------------------------------------------------------------------------
; Definizione DATAGROUP
;-------------------------------------------------------------------------------------
;DATAGROUP
;-------------------------------------------------------------------------------------
; Configurazione Bus
;-------------------------------------------------------------------------------------
BUS
     1  1CPUB   02
     2  1MIXA   00
     3  .
     4  .
 
;-------------------------------------------------------------------------------------
; Definizione Variabili INPUT
;-------------------------------------------------------------------------------------
INPUT
ifAvMan     F    2.INP01                ;Ingresso di avanti manuale
ifInMan     F    2.INP02                ;Ingresso di indietro manuale
ifStart     F    2.INP03                ;Ingresso di START asse
ifStop      F    2.INP04                ;Ingresso di STOP asse
 
;-------------------------------------------------------------------------------------
; Definizione Variabili OUTPUT
;-------------------------------------------------------------------------------------
OUTPUT
ofToll      F    2.OUT01                ;Uscita di asse in tolleranza
ofAxeFermo  F    2.OUT02                ;Uscita di asse fermo
 
;-------------------------------------------------------------------------------------
; Dichiarazione device
;-------------------------------------------------------------------------------------
INTDEVICE
;Nome   Tipo   TCamp   Contatore   Inter   AbilZero  OutAnal
Asse    ANPOS  0004    2.CNT01     1       2.INP01   2.AN01
 
END

;*************************************************************************************
; Nome File: TASK_00.MOD
; Progetto : EX_ANPOS
; Descrizione: Gestione Posizionamento
;*************************************************************************************
 
;-------------------------------------------------------------------------------------
; Operazioni di Inizializzazione Asse
;-------------------------------------------------------------------------------------
Asse:cntratio = 100000                     ;Risoluz.encoder = Spazio in 1 giro
                                           ;encoder(Um) / impulsi giro encoder
Asse:maxvel = 100000                       ;Velocita` max. = Velocità Asse con
                                           ;uscita analogica a 10V (CALON/
vout=100)
Asse:maxpos = 999999                       ;Quota massima
Asse:minpos = -999999                      ;Quota minima
Asse:maxfollerr = 10000                    ;Errore di inseguimento
Asse:unitvel = 0                           ;Unita di tempo della velocità
Asse:decpt = 0                             ;Cifre decimali
Asse:rampmode = 0                          ;Tipo di rampe utilizzate
Asse:taccdec = 100                         ;Tempo di accelerazione e di decelerazione
Asse:tacc = 0                              ;Tempo di accelerazione (non utilizzato)
Asse:tdec = 0                              ;Tempo di decelerazione (non utilizzato)
Asse:tinv = 0                              ;Tempo di inversione asse
Asse:toll = 5                              ;Tolleranza
Asse:toldly = 10                           ;Tempo di ritardo attivaz. tolleranza
Asse:prsmode = 0                           ;Tipo di ricerca di preset
Asse:prspos = 0                            ;Quota di preset
Asse:prsdir = 0                            ;Direzione della ricerca di preset
Asse:prsvel = (20 * Asse:maxvel)/100       ;Velocità di preset (20% della
vel.max.)
Asse:sprsvel = (10 * Asse:maxvel)/100      ;Velocità di ricerca impulso di
                                           ;zero (10% della vel.max.)
Asse:offset = 0                            ;Tensione di offset
Asse:pgain = 10                            ;Guadagno proporzionale
Asse:feedfw = 1000                         ;Feedforward
Asse:integt = 0                            ;Tempo di integrale
Asse:derivt = 0                            ;Tempo derivativo
INIT Asse                                  ;Inizializza il device
WAIT Asse:st_init                          ;Attendi che il device sia inizializzato
CNTUNLOCK Asse                             ;Sblocca conteggio
WAIT NOT Asse:st_cntlock                   ;Attendi che il conteggio sia sbloccato
CNTDIR Asse                                ;Imposta il senso del conteggio
WAIT NOT Asse:st_cntrev                    ;Attendi che sia impostato il senso
                                           ;del conteggio
REGON Asse                                 ;Abilita la regolazione
WAIT NOT Asse:st_regoff                    ;Attendi l'abilitazione alla regolazione
RESUME Asse                                ;Togli l'asse dallo stato di emergenza
WAIT NOT Asse:st_emrg                      ;Attendi che l'asse non sia in emergenza
LOOPON Asse                                ;Aggancia loop di reazione dell'asse
WAIT Asse:st_loopon                        ;Attendi che sia agganciato il loop di
                                           ;reazione dell'asse
IF (slVelAsse EQ 0)                        ;Nel caso in cui il set di velocità
                                           ;dell'asse sia zero
  slVelAsse = 50                           ;Imposta una velocità di posizionamento
ENDIF
IF (slQuotaPos EQ 0)                       ;Nel caso in cui la quota di
                                           ;posizionamento dell'asse sia zero
  slQuotaPos = 2000                        ;Imposta una quota di posizionamento
ENDIF
 
;-------------------------------------------------------------------------------------
; Operazioni di Posizionamento
;-------------------------------------------------------------------------------------
; ------------------------------- variabili utilizzate ------------------------------
; slVelAsse: Variabile impostabile che rappresenta la velocità dell'asse
; (espressa in % della vel.max.)
; slQuotaPos: Variabile impostabile che rappresenta la quota di posizionamento
dell'asse
; ---------------------------------- flag utilizzati --------------------------------
; gfMovMan: movimento manuale in corso
; gfMovAuto: Movimento automatico in corso
;-------------------------------------------------------------------------------------
MAIN:
;-------------------------------------------------------------------------------------
; Gestione uscite
;-------------------------------------------------------------------------------------
ofToll = Asse:st_toll                   ;Imposto l'uscita di tolleranza come
                                        ;lo stato di tolleranza
ofAxeFermo = Asse:st_still              ;Imposto l'uscita di asse fermo come
                                        ;lo stato di asse fermo
 
;-------------------------------------------------------------------------------------
; Gestione movimenti automatici
;-------------------------------------------------------------------------------------
IF ifStart                                      ;Attende l'ingresso di START
  IF NOT gfMovMan                               ;Controlla che non ci siano movimenti
                                                ;manuali
    IF Asse:st_still                            ;Controlla che l'asse sia fermo
      Asse:setvel=(slVelAsse*Asse:maxvel)/100   ;Imposta la velocità dell'asse
      Asse:setpos = slQuotaPos                  ;Imposta la quota di posizionamento
      START Asse                                ;Esegue lo start dell'asse
      gfMovAuto = 1                             ;Segnala movimento automatico in corso
    ENDIF
  ENDIF
ENDIF
IF ifStop                                       ;Attende l'ingresso di STOP
  IF NOT Asse:st_still                          ;Controlla che l'asse NON sia fermo
    STOP Asse                                   ;Esegue lo stop dell'asse
  ENDIF
ENDIF
IF gfMovAuto                                    ;Controlla segnalazione movimento
                                                ;automatico in corso
  IF Asse:st_still                              ;Controlla che l'asse sia fermo
    gfMovAuto = 0                               ;Resetta stato di movimento Automatico
  ENDIF
ENDIF
 
;-------------------------------------------------------------------------------------
; Gestione movimenti manuali
;-------------------------------------------------------------------------------------
IF ifAvMan                                      ;Attende l'ingresso di movimento manuale
  IF NOT (gfMovAuto OR gfMovMan)                ;Controlla che non ci siano movimenti
                                                ;automatici o manuali
    IF Asse:st_still                            ;Controlla che l'asse sia fermo
      Asse:setvel=(slVelAsse*Asse:maxvel)/100   ;Imposta la velocita` dell'asse
        MANFW Asse                              ;Avanti asse in manuale
        gfMovMan = 1                            ;Segnala movimento manuale in corso
      ENDIF
    ENDIF
ENDIF
IF ifInMan                                      ;Attende l'ingresso di movimento manuale
  IF NOT (gfMovAuto OR gfMovMan)                ;Controlla che non ci siano movimenti
                                                ;autometici o manuali
    IF Asse:st_still                            ;Controlla che l'asse sia fermo
      Asse:setvel=(slVelAsse*Asse:maxvel)/100   ;Imposta la velocita` dell'asse
      MANBW Asse                                ;Avanti asse in manuale
      gfMovMan = 1                              ;Segnala movimento manuale in corso
    ENDIF
  ENDIF
ENDIF
 
IF gfMovMan                                     ;Se l'asse si muove in manuale
  IF NOT (ifAvMan OR ifInMan)                   ;Se gli ingressi di avanti e indietro
                                                ;manuale sono OFF
    STOP Asse                                   ;Ferma l'asse
    gfMovMan = 0                                ;Togli la segnalazione di asse in
                                                ;movimento manuale
  ENDIF
ENDIF
;-------------------------------------------------------------------------------------
; Operazioni finali
;-------------------------------------------------------------------------------------
  WAIT 1
  JUMP MAIN
END